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Dynamics and Control Problems 







BASIC PROBLEMS 
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Spring-and-Mass Models 






Admittance model of the manipulator. 
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Condition for manipulator passivity 



Impedance model of the environment. 
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Condition for environmental passivity 
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Model of manipulator coupled to environment. 





A Simple Example 





2. Torque loop 

3. Impedance 
shaping 





ORtGINAS- F>C* iS 
OF POOR QUALITY 




Model of a "typical" actuator. 


Parameter 

Value 

Units 

Motor Inertia, J m 
(reflected to output side) 

0.0934 

kg-m 2 

Motor Viscous Damping, B m 
(reflected to output side) 

3.4 

N-m/(rad/s) 

Harmonic Drive Stiffness, K s 

1600 

N -m/rad 

Load Viscous Damping, Bi 

0.7 

N-m/(rad/s) 

Representative Load Inertia, Ji 

0.64 

kg-m 2 

Gear Ratio 

100:1 

N/A 


Representative Actuator Parameters 









Moderate fidelity model of PD position-controlled actuator. 



Frequency, Hz 


Minimum total energy delivered to the system over 1 second for a 1 N-m 
amplitude sinusoid disturbance torque (100 Hz bandwidth torque loop, 100 Hz 
bandwidth sensor dynamics, 1000 Hz bandwidth amplifier dynamics, 200 Hz 

sample rate, Kp=116, Kv=12.5) 






Real Axis 


Nyquist diagram of the admittance response for the PD position-controlled 
actuator (sampling and ZOH modeled by time delay of half the sampling period). 
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Real Axis xlO-4 

Nyquist diagram of the admittance response above 50 Hz for the PD position- 
controllea actuator (sampling and ZOH modeled by time delay of half the 

sampling period). 






Generalized Actuator Control Block Diagram. 



Standard H«> minimization problem. 





Phase, deg Magnitude, dB 



Frequency, Hz 



Frequency, Hz 


Achieved (solid line) and target (dashed line) admittance responses for example H<„ design using 

Ki(s). 





Conclusions 
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